﻿// Решение ДУ полета

nxt = Knx * (Vc - sqrt(Vx ^ 2 + Vy ^ 2 + Vz ^ 2));

dH = Hz - y;

Vyz = Kdh * dH;

Vyz = (Vyz > 25.0) ? 25.0 : ((Vyz < -15.0) ? -15.0 : Vyz);

nyt = 1 + Kny * (Vyz - Vy);

nzt = Knz * (Vx * (Zz - z) - Vz * (Xz - x));
nzt = (nzt > 5.0) ? 5.0 : ((nzt < -5.0) ? -5.0 : nzt);

//x = 1;

x' = Vx;
y' = Vy;
z' = Vz;
Vx' = (g/sqrt((Vx)^2+(Vy)^2+(Vz)^2))*Vx*(nxt-Vy*nyt/sqrt((Vx)^2+(Vz)^2))-g*Vz*nzt/sqrt((Vx)^2+(Vz)^2);
Vy' = (g/sqrt((Vx)^2+(Vy)^2+(Vz)^2))*Vy*nxt+(g/sqrt((Vx)^2+(Vy)^2+(Vz)^2))*nyt*sqrt((Vx)^2+(Vz)^2)-g;
Vz' = (g/sqrt((Vx)^2+(Vy)^2+(Vz)^2))*Vz*(nxt-Vy*nyt/sqrt((Vx)^2+(Vz)^2))+g*Vx*nzt/sqrt((Vx)^2+(Vz)^2);
